Algoritmo matriz diagonal en pseint